%% trilat v1 data test

PosSat=[    4057484  -15010027   21390293
   19256229   -7892167   16596261
   25621322    7001001    1723914
   16857143    1950345   20315399
   -4698607   21273922   15101204
   13596420   21111556    8603486
   10361156   10815640   21876136
   22873192    9593720    9604642
   26271275    4211940    -126129
    7845645   25338739    3207334];

Dobs=[22508228 
    20770253 
    22686678 
    20116405 
    25115714 
    23261544 
    21057066 
    21460702 
    22965151 
    25471833];

X0=[4202000 ;178000 ;4780000 ; 0];
